#include "DriveDirectionIndicator.h"
#include "../Robotmap.h"
#include "../Commands/DisplayDirection.h"


DriveDirectionIndicator::DriveDirectionIndicator() : Subsystem("DriveDirectionIndicator") {
	direction = new Relay(RobotMap::TRACTION_DRIVING_DIRECTION_RLY, 
						  Relay::kBothDirections);
	driveForward = true;
}

void DriveDirectionIndicator::InitDefaultCommand() {
	SetDefaultCommand(new DisplayDirection());
}

void DriveDirectionIndicator::setForwardDirection() {
	driveForward = true;
	direction->Set(Relay::kForward);
}

void DriveDirectionIndicator::setReverseDirection() {
	driveForward = false;
	direction->Set(Relay::kReverse);
}

void DriveDirectionIndicator::doNothing() {
	
}

bool DriveDirectionIndicator::isDrivingForward() {
	return driveForward;
}
